Test name: Open Loop with LQR focus on travel
Variables changed: Q for travel set to 1000, others 1
Expected behaviour: Travel should be followed much close
Results: As expected, but still some constant deviation